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^  ABSTRACT 

'  -iWThis  paper  investigates  the  computational  complexity  of  planmng  the 
motion  of  a  body  B  in  2-D  or  3-D  space,  so  as  to  avoid  collision  with  moving  obs¬ 
tacles  of  known,  easily  computed,  trajectories.  Dynamic  movement  problems 
are  of  fundamental  importance  to  robotics,  bjt  their  computational  complexity 
has  not  previously  been  investigated. 


We  provide  evidence  that  the  3-D  dynamic  movement  problem  is  intractable 
even  if  B  has  only  a  constant  number  of  degrees  of  freedom  of  movement.  In 
particular,  we  prove  the  problem  is  PBPACE- hard  if  B  is  given  a  velocity 
modulus  bound  on  its  movements  and  is  NP  hard  even  if  B  has  no  velocity 
modulus  bound,  where  in  both  cases  B  has  6  degrees  of  freedom.  To  prove 
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uses  time  to  encode  configurations  (whereas  previous  lower  bound  proofs  in 
robotics  used  the  system  position  to  encode  configurations  and  so  required 
unbounded  number  of  degrees  of  freedom). 


We  also  investigate  a  natural  class  of  dynamic  problems  which  we  call 
asteroid,  avoidance  problems  :  B.  the  object  we  wish  to  move,  is  a  convex 
polyhedron  which  is  free  to  move  by  translation  with  bounded  velocity  modulus, 
and  the  polyhedral  obstacles  have  known  translational  trajectories  but  cannot 
rotate.  This  problem  has  many  applications  to  robot,  automobile,  and  aircraft 
collision  avoidance. *J3ur  mam  positive  results  are  polynomial  time  algorithms 
for  the  2-D  as  term  devoid  ance  problem  with  bounded  number  of  obstacles  as 
well  as  single  exponential  time  and  n9(l0gn)  space  algorithms  for  the  3-D 
asteroid  avoidance  problem  with  an  unbounded  number  of  obstacles.  Our  tech¬ 
niques  for  solving  these  aswmid  avoidance  problems  are  novel  in  the  sense  that 
.  they  are  completely  unrelated-.to  previous  algorithms  for  planmng  movement  in 
the  case  of  static  obstacles 


We  also  give  some  additional  positive  results  for  various  other  dynamic 
movers  problems,  and  in  particular  give  polynomial  time  algorithms  for  the  case 
in  which  B  has  no  velocity  bounds  and  the  movements  of  obstacles  are  alge¬ 
braic  in  space-time. 
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ABSTRACT 

This  paper  investigates  the  computational  complexity  of  planning  the 
motion  of  a  body  B  in  2-D  or  3-D  space,  so  as  to  avoid  collision  with  moving  obs¬ 
tacles  of  known,  easily  computed,  trajectories  Dynamic  movement  problems 
are  of  fundamental  importance  to  robotics,  but  their  computational  complexity 
has  not  previously  been  investigated 

We  provide  evidence  that  the  3-D  dynamic  movement  problem  is  intractable 
even  if  B  has  only  a  constant  number  of  degrees  of  freedom  of  movement.  In 
particular,  we  prove  the  problem  is  P.SA4C'£'-hard  if  B  is  given  a  velocity  » 
modulus  bound  on  its  movements  and  is  NP  hard  even  if  B  has  no  velocity 
modulus  bound  where  in  both  cases  B  has  6  degrees  of  freedom.  To  prove 

f  V*  »  w.  ^  —  •  .1  4  -•  —  «  1 1  «  4  V.  a  J  "ii  ■*-*—  "1  ^  *  *  rv  v-»  r*  f  T  i  n"i»v  m  **  *”»  V>i  i  »-»  r»  ^ 
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uses  time  to  encode  configurations  ^whereas  previous  lower  bound  proofs  in 
robotics  used  the  system  position  tc  encode  configurations  and  so  required 
unbounded  number  of  degrees  of  freedom). 

We  also  investigate  a  natural  class  of  dynamic  problems  which  we  call 
asteroid  avoidance  problems  B,  the  object  we  wish  to  move,  is  a  convex 
polyhedron  which  is  free  to  move  by  translation  with  bounded  velocity  modulus 
and  the  pohnedral  obstacles  have  known  translational  trajectories  but  cannot 
rotate.  This  problem  has  many  applications  to  robot,  automobile,  and  aircraft 
collision  avoidance  Our  mam  positive  results  are  polynomial  time  algorithms 
for  the  2-D  asteroid  avoidance  problem  with  bounded  number  of  obstacles  ac 
well  as  single  exponential  time  and  n0(lcg,,)  space  algorithms  for  the  3-D 
asteroid  avoidance  problem  with  an  unbounded  number  of  obstacles.  Our  tech¬ 
niques  for  solving  these  asteroid  avoidance  problems  are  novel  in  the  sense  that 
they  are  completely  uurelated  to  pr  evious  algorithms  for  planning  movement  m 
the  case  of  static  obstacles 

We  also  give  some  additional  positive  results  for  various  other  dynamic 
movers  problems,  and  in  particular  give  polynomial  time  algorithms  for  the  case 
in  which  B  has  no  velocity  bounds  and  the  movements  of  obstacles  are  alge¬ 
braic  in  space-time 

1.  INTRODUCTION  ^ 

1.1  Static  Movers  Problems 

The  static  movers  problem  is  to  plan  a  collision-free  motion  of  a  body  B  in 
2-D  or  3-D  space  avoiding  a  set  of  obstacles  stationary  in  space  For  example  B 
may  be  a  sofa  which  we  a  ish  to  move  through  a  room  crowded  with  furniture,  or 
B  may  be  an  articulated  robot  arm  which  we  wish  to  move  in  a  fixed  workspace 

'Reif.  79]  first  showed  ihat  a  generalized  3-D  static  movers  problem  is 
PSPACE -hat  d.  where  B  -  c-r.-usis  of  n  linked  polyhedra.  [Hopcroft,  Joseph  and 
Whitesides.  04]  and  Hopei  eft.  Schwarts  end  Sharir,  84]  later  proved  PS  PACE- 
lower  bounds  for  2-D  static  movers  problems  If  the  number  of  degrees  of  free¬ 
dom  of  motion  is  kept  constant  then  the  problem  has  polynomial-time  solutions 
provided  that  the  geometric  constraints  on  the  motion  can  be  stated  algebra. - 
cally  [Schwartz  and  Sham.  83b]  Vcr c  i_-iTnent  polynomial  time  algorithms  for 
various  specific  cases  of  static  movers  problems  are  given  in  [ Lozano-Perez  and 
Wesley.  79  Reif,  79  Schwartz  and  Sharir.  83a. c,  04.  -Hopcroft,  Joseph  and  White- 
sides  85.  Sharir  and  Anel-Shefli.  83,  0  Dunlamg,  Sharir  andOfap.  83.  O'Dunlamg 
and  Yap,  8o] 
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1,2  Dynamic  Movers  Problems 

In  this  paper,  we  consider  the  problem  of  planning  a  collision-free  motion  of 
a  body  B  which  is  free  to  move  within  some  2-D  or  3-D  space  S,  containing 
several  obstacles  which  move  in  S  along  known  trajectories.  We  require  that  the 
obstacle  trajectories  be  easily  computable  functions  of  time,  and  not  be  at  all 
dependent  on  any  movement  of  B .  Some  applications  are: 

(1)  Robotic  Collision  Avoidance.  B  might  be  a  robot  arm  which  must  be 
moved  through  a  workspace  such  as  an  assembly  line  in  which  various  machine 
parts  make  predictable  movements. 

(2)  Automobile  Collision  Avoidance.  B  is  an  automobile  with  an  automatic 
steering  system  which  must  avoid  collision  with  other  automobiles  with  known 
trajectories  on  a  highway. 

(3)  Aircraft  Collision  Avoidance.  B  is  an  aircraft  which  we  wish  to 
automatic-pilot  through  an  airspace  containing  a  number  of  aircraft  and  other 
obstacles  w-ith  known  flight  paths 

(4)  Spacecraft  Navigation.  B  might  be  a  spacecraft  which  we  wish  to 
automatically  maneuver  among  a  field  of  moving  obstacles,  such  as  asteroids. 

Although  the  dynamic  movers  problem  is  fundamental  to  robotics,  we  know 
of  no  previous  work  which  has  considered  the  computational  complexity  of  such 
problems 

We  can  formally  define  a  dynamic  movers  problem  as  follows.  Let  B  be  an 
arbitrary  fixed  system  of  moving  bodies  (each  of  which  can  translate  and  rotate, 
and  some  of  which  may  be  hinged),  having  overall  d  degrees  of  freedom  B  is 
allowed  to  move  within  a  space  5  which  contains  a  collection  of  obstacles  moving 
in  an  arbitrary  (but  known)  manner  To  cope  with  the  time-varying  environment 
we  represent  the  time  as  an  additional  parameter  of  the  configuration  of  B. 
More  precisely,  we  define  the  free  configuration  space  FP  of  B  to  consist  o<  all 
pairs  [X.t]  e  +  where  X  e  E*  represents  a  configuration  of  B,  and  such 
thai  if  at  time  t  the  system  B  is  at  configuration  X  then  B  does  not  meet 
any  obstacle  at  that  time  In  this  representation  of  FP  a  continuous  motion  of 
B  is  represented  by  a  continuous  arc  [xt,f]=p(£),  which  is  monotone  in  t 
Note  that  the  slope  of  this  arc  (i  dative  to  the  f-axis)  represents  the  "velocity" 
(i.e  .  the  rate  of  change  of  the  parameters  of  the  motion)  of  B  If  we  impose  no 
restrictions  on  this  velocity,  any  such  t  -monotone  path  corresponds  to  a  possi¬ 
ble  motion  of  B  However,  the  dynamic  version  of  the  problem  is  usually  further 
complicated  by  imposing  certain  constraints  on  the  allowed  motions  of  B  One 
such  constraint  is  that  the  velocity  of  B  has  a  bounded  modulus  (the  modulus 
is  the. Euclidean  norm  of  the  velocity  vector)  Such  a  constraint  of  a  "uniform” 
bound'  on  velocity  of  B  is  particularly  appropriate  if  B  is  a  single  rigid  body 
free  only  to  translate,  most  of  the  versions  of  the  problem  (e  g  .  the  astc-oid 
avoidance  problem)  studied  in  this  paper  will  be  of  this  k.nd 

Using  the  above  terminology  the-  problem  that  we  wish  to  solve  is  Given  an 
initial  fre-e-  configuration  ) A'c.O]  and  a  final  free  configuration  \Yj.7].  plan  a  con¬ 
tinuous  motion  of  B  (if  one  exists)  between  these  configurations  which  will 
avc.d  collision  with  the  obstacles,  or  else  report  that  no  such  motion  is  possible 
(Note  that  we  also  specify  the  time  T  at  which  wc  want  to  be  at  the  final 
configurations  X{,  as  will  be  s&en  below,  a  variant  of  our  techniques  can  be  used 
to  obtain  minimal  time  movement  of  B  )  In  other  words  we  wish  to  find  a  mono¬ 
tone  path  in  FP  between  the  two  configurations  .A'c.O]  and  A',. 7],  where  the 
patr.  satisfies  the  velocity  modulus  bounds  constraint  nf  imposed) 

The  goal  of  this  paper  is  to  systematically  investigate  the  complexity  of 
various  fundamental  classes  of  dynamic  moyement  planning  problems 
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1.3  Summary  of  Our  Results 

In  summary,  the  main  results  of  this  paper  are: 

(1)  PSP  ACE  louder  bounds  of  3-D  dynamic  movement  planning  of  a  single 
disk  with  bounded  velocity  and  rotating  obstacles. 

(2)  decision  algorithms  for  1-P,  2  D  or  3-D  dynamic  movement  planning  of 
a  polyhedron  with  bounded  velocity  and  purely  translating  obstacles. 

We  also  have  additional  results  for  some  dynamic  movement  planning  prob¬ 
lems  with  unbounded  velocity. 

1.4  Our  Lower  Bound  Results  for  Rotating  Obstacles. 

In  the  case  the  obstacles  rotate,  they  may  generate  non-algebra. c  trajec¬ 
tories  in  space-time  which  appear  to  make  movement  planning  intractable  Our 
main  negative  yesult ,  given  in  Section  2,  is  a  proof  that  3-D  dynamic  movement 
planning  with  rotating  obstacles  is  PSPACE- hard,  even  in  the  case  the  object  to 
be  moved  is  a  disc  with  bounded  velocity.  (We  also  have  a  related  .VP-hardness 
result,  described  below,  in  the  case  B  has  no  velocity  bounds  ) 

Remark.  All  previously  known  lower  bound  results  for  movers  problems 
utilize  the  position  of  B  for  encoding  n  bits,  and  thus  require  that  3  have 
f !(n)  degrees  of  freedom.  We  use  substantially  different  techniques  /or  our 
lower  bound  results.  In  particular,  we  use  time  to  encode  the  configuration  of  a 
Turing  machine  that  we  wish  to  simulate  (therefore  we  call  our  construction  a 
"Imvc-mactune").  In  our  lower  bound  construction  it  suffices  that  B  have  only 
0(1)  degrees  of  freedom  (In  contrast,  static  movement  planning  is  polynomial 
time  decidable  in  case  B  has  only  0(i)  degrees  of  freedom)  The  key  to  our 
PSPACE'- hardness  proof  is  a  "delay  box"  construction,  which  by  use  of  rotating 
rbstacles  generates  an  exponential  number  of  disconnected  ccmponents  in  the 
free  configuration  space 

1.5  Efficient  Algorithms  for  Asteroid  Avoidance  Problems 

In  Section  3  we  investigate  an  interesting  class  of  tractable  dynamic  move¬ 
ment  problems  where  the  obstacles  do  not  rotate  An  asteroid  avoidance  prob¬ 
lem  is  the  dynamic  movement  problem  where  ecch  of  the  obstacles  is  a 
polyhedron  with  a  fixed  (possibly  distinct)  translational  velocity  and  direction. 

ar. d  B  is  a  convex  polyhedron  w'hich  may  make  arbitrary  translational  move¬ 
ments  but  with  a  bounded  velocity  modulus  Neither  B  nor  the  obstacles  may 
rotate  (This  problem  Ki  named  after  the  well  known  ASTEROID  video  game 
where  a  spacecraft  of  limited  velocity  modulus  must  be  maneuvered  to  avoid 
swiftly  moving  asteroids  )  The  problem  is  efficiently  solved  in  the  '-D  case  by 
line  scanning  techniques  but  is  quite  difficult  in  the  2-D  and  3-D  cases 

The  assumptions  of  the  asteroid  avoidance  problem  are  applicable  m  mam. 
of  the  above  mentioned  practical  problems,  such  as  robot,  automobile,  airplane 
and  spacecraft  collision  avoidance  problems,  where  both  B  and  the  obstacles 
are  approximated  by  convex  polyhedra 

The  major  positive  results  of  this  paper  are  a  polynomial  time  algorithm  for 
the  2-D  asteroid  avoidance  problem  with  a  bounded  number  of  convex  obstacles 
as  well  as  2nC>u'  time  and  nc']o&n)  space  decision  algorithms  for  the  3-D 

as. eroid  avoidance  problem  with  an  unbounded  number  of  obstacles  The 
methods  we  develop  (such  as  the  use  of  normal  movements)  to  solve  asteroid 
avoidance  problems  are  quite  different  from  those  previously  used  to  solve 
static  movement  problems  and  seem  likely  to  be  fundamental  to  the  efficient 
solution  of  ether  problems  in  planning  dynamic  movement 
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We  also  have  a  simple  polynomial  Lime  algorithm  for  the  3-D  asteroid 
avoidance  problem  with  an  unbounded  number  of  obstacles  where  B  has  max¬ 
imum  velocity  bound  greater  than  any  obstacle,  and  must  only  avoid  collision. 


1.6  Dynamic  Movers  Problems  vrith  no  Velocity  Bounds  on  B 

In  the  final  Section  4  of  this  paper,  we  consider  the  complexity  of  dynamic 
movement  planning  in  the  case  B,  the  object  to  be  moved,  has  no  velocity 
modulus  bounds  We  first  show  that  the  3-D  dynamic  movement  problem  for  a 
cylinder  B  with  unrestricted  velocity  is  .VP-hard 

We  then  consider  algorithms  for  dynamic  movement  planning  in  the  case  in 
which  no  velocity  bounds  are  imposed  on  the  motion  of  B,  and  the  geometric 
constraints  on  the  possible  positions  of  B  can  be  specified  by  algebraic  equali¬ 
ties  and  inequalities  (in  the  parameters  describing  the  possible  degrees  of  free¬ 
dom  of  B  and  in  time  ).  We  show  that  this  problem  is  solvable  in  polynomial 
time  for  any  fixed  moving  system  B  (which  may  consist  of  several  independent 
hinged  translating  and  rotating  bodies  in  2-D  or  3-D).  -•- 


2  A  TIME  MACHINE  SIMULATION  OF  PSPACE 

We  show  here  that 

THEOREM  2.1.  Dynamic  movement  planning  in  the  case  of  bounded  velocity  ts 
PBPACE  -hard,  even  in  the  case  where  the  body  B  to  be  moved  is  a  disc 

Proof.  Let  M  be  a  deterministic  Turing  machine  with  space  bound 
S{n)  -  n we  can  assume  Si  has  tape  alphabet  tO.ij,  state  set 

Q  -  jO . with  initial  state  0  and  accepting  state  1.  A 

configuration  of  M  consists  of  a  tuple  C  =  {u.g.h)  where  u  e  {0,ljs;n)  is  the 
current  tape  contents,  q  €  Q  is  the  current  stale,  and  h  e.$l,  .  .  .  .  S(n) j  is 
the  position  of  the  tape  head.  Let  next{C)  be  the  configuration  immediately 
succeeding  C  Given  input  string  tv  e  5  0. 1  jn  considered  to  be  a  binary  number, 
the  initial  configuration  is  C0  =  (ii;0s'"'~n  ,0,0)  We  can  assume  (0s^n,,l,0)  is  the 
accepting  configuration  We  can  also  assume  that  if  M  accepts,  then  it  does  so 
in  exactly  7  =  2cS'n)  steps  for  some  constant  c  >  0  Thus  '/  accepts  iff  Cy  is 
accepting,  where  Cc,C>,  .  .  ,  Cr  is  the  sequence  of  configurations  of  SI  satisfy¬ 

ing  Q  =  next  ( C,_;)  for  i  =  i,  ....  7 

To  simulate  the  computation  of  M  on  input  w,  we  will  construct  a  3-D 
instance  of  the  dynamic  movers  problem  where  the  body  B  to  be  moved  is  a 
disc  of  radius  1.  and  where  we  bound  the  velocity  modulus  of  B  bv 
v  -  100  Q\ S{n)  Tne  basic  idea  of  our  simulation  is  to  use  time  to  encode  the 
current  configuration  of  M 

Let 


N  ~  S(n)  +  flog  Q  ]  +  flog 5  [n )]  . 

We  shall  encode  each  configuration  C  =  ( u.q.h )  as  an  v  bit  binary  number 

#{C)  ~  u  +  q2s'n)  +  /isSPiHfic,;  Q  \ 

so  05  #(C)  <  ZN .  A  surface  configuration  of  Si  is  a  triple  <u^.q.h>  where 
u n  e  J0.1J  is  the  value  of  the  tape  ceil  currently  scanned,  q  is  the  current  state 
and  h  is  the  head  position  Note  that  there  are  only  a  polynomial  number  of 
surface  configurations  For  each  q  e  Q,  h  e  (1,  .  ,S(n)|,  and  uh  e  we 

associate  a  distinguished  position  P<un.q.h>  of  B  in  3-dimens'onal  space 
corresponding  to  surface  configuration  <uh.q,h>  of  M 
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We  will  fix  a  distinguished  initial  position  pc.  of  B  in  3-dirnensional  space 
B  is  located  at  p0  at  the  initial  time  f0  =  u  .  The  dynamic  movers  problem  will 
be  to  move  B  so  that  it  is  at  position  pc  also  at  time  tT  -■  2i +  T2S  We  will 
construct  a  collection  of  moving  obstacles  which  will  force  B  to  move  to  posi¬ 
tion  po  exactly  at  each  time  tx  a  w  such  that  =  jfCx  +■  i2v,  and 

tx  <  |ftj  +  ~  Thus  the  lower  .N  bits  of  tx  encode  the  configuration  Cx  and  the 

higher  bits  encode  the  step  number.  (Note  that  ic  encodes  the  .initial 
configuration,  at  step  0,  and  ty  encodes  the  final  configuration  at  step  T  ) 

To  simulate  M .  we  need  two  kinds  of  devices,  one  to  test  that  M  is  at  a  par¬ 
ticular  surface  configuration,  and  the  ether  to  simulate  one  step  of  M  at  a 
specific  surface  configuration  The  first  kind  of  device  is  constructed  as  follows 
To  test  a  given  bit  b, .  in  position  j  of  tx,  we  require  that  B  be  forced  (by  a 

p 

semiaisc  rotating  once  every  —  time  units)  to  enter  a  cylindrical  box  (which 
we  call  a  "test  box")  with  two  exit  slots:  exitc  and  exit  t  We  design  the  box  so 
that  it  is  swept  by  a  semidisc  once  every  —  time  units,  and  furthermore  b}  =  1 

iff  exit  i  is  open  iff  ezit0  is  closed  at  time  ft|  +  Aj,  where  A;  is  the  time 

required  by  B  to  reach  the  entry  slot  of  this  test  box.  A  semidisc  rotating  once 
every  23  time  units  can  be  used  to  open  and  close  these  exits  at  the  appropriate 
0  0 
times  Thus  we  can  design  the  test  box  so  that  in  —  time  units,  B  is  forced  to 

move  through 

Hence  (by  using  a  balanced  tree  of  such  test  boxes  plus  some  additional 
sweeping  semidiscs),  we  can  force  B  to  be  moved  from  pc  to  arrive  in  dis¬ 
tinguished  position  A>  in  time  at  least  |rtj  i-  :  and  less  than  |ftJ  +  1  +  ~ 

Let  Cl  +  )  =  next{Cx )  ~  ( u'.q'.h ')  be  the  configuration  of  M  immediately  follow¬ 
ing  Cx  Since  #Cx  +  }  -  depends  only  on  H,q,h>,  there  is  a  function 
g[uh.q.h)  such  that  #Ct«. ,  =  #CX  +  g  [uh  ,q  ,h)  and  g{uK,q.h)  <  2,v  Hence  we 
will  require  an  additional  gadget,  to  be  described  below,  to  force  B  to  move 
from  position  P<Utlq.h>  back  again  to  position  pc  at  time  ft4.i  such  that 

+  =  #C.  +  i  +  (1  +  1)2"  =  jt,j  +  g\un.q.f t)  s-  2V  , 

and  ,  «  |ft  +  1j  +  The  total  time  delay  for  this  move  must  be 

~  i  .  ~  I_  N  i  aV 

j  \U/l^  ^  J  T  ^  ~  •  - 

Thus  our  key  remaining  construction  still  required  is  a  "delay  A  box" 
(where  A  is  a  number  less  than  Z2W)  If  B  enters  the  delav  box  at  anv  time 

2 

t  ^  0  such  that  t  <  U j  +  — ,  then  B  must  be  m<-.de  to  exit  the  delay  box  at  a 

v 

time  at  least  UJ  +  A,  and  at  most  (fj  +  A  +  — :  Note  we  can  assume  A  is  greater 

v 

than  a  constant,  say  10,  or  else  the  construction  is  trivia!  (Our  construction  is 
not  trivial,  however,  in  the  general  case  where  A  is  exponential  in  N  since  it  is 
based  on  an  explicit  construction  of  an  exponential  number  of  disconnected 
components  in  the  free  configuration  space,  using  only  a  small  number  of  mov¬ 
ing  (essentially  rotating)  obstacles  having  polynomially  describable  velocities  ) 

Our  delay  box  consist5  of  a  fixed  torus-shaped  obstacle,  plus  some  addi¬ 
tional  moving  obstacles  (see  Figure  1)  We  can  precisely  define  this  torus  as  the 
surface  generated  by  the  revolution  of  an  (imaginary)  circle  of  radius  3  around 

the  x  axis,  so  that  its  center  is  always  at  distance  ^-from  the  x  axis,  and  so 

2fr 
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that  the  circle  is  always  coplanar  with  the  x-axis  Let  9  be  the  angular  posi¬ 
tion  of  a  point  with  respect  to  rotation  around  the  x-axis 

The  torus  will  have  open  entrance  and  exit  slots  at  9  =  0  and  0  =  n, 
respectively,  just  sufficiently  wide  for  entrance  and  exit  of  disc  B  from  the 
torus  The  idea  of  our  delay  box  construction  will  be  to  create  various  discon¬ 
nected  "free  spaces"  within  the  torus  in  which  B  must  be  located.  These  free 
spaces  will  be  constructed  so  that  they  move  within  the  torus  n  radians  of  9 
(i  e.,  make  1/2  a  revolution)  in  A  time  units.  Once  B  enters  the  torus  via 
the  entrance  slot,  our  construction  will  foi  ce  B  to  be  located  in  exactly  one 
such  free  space,  and  revolve  with  it  around  the  torus  until  B  leaves  the  interior 
of  the  torus  at  the  exit  slot  after  the  required  delay  of  A  time  units 

We  now  show  precisely  how  to  create  these  moving  "free  spaces".  A  moving 
obstacle  D  moves  through  the  interior  of  the  torus  with  angular  velocity  (with 

respect  to  0)  of  16  +  “-revolutions  per  time  unit.  D  consists  of  three  discs 

Dq.D^Dz  placed  face  to  face  so  that  their  centers  are  nearly  in  contact  and  so 
that  they  are  each  coplanar  with  the  x-axis.  Discs  Dq,B\,D2  are  of  radius 
almost  3  D 0  has  a  1/4  section  removed,  2?j  has  a  3/4  section  removed,  and  Dz 
has  a  1/2  section  removed.  D{  and  D 2  each  rotate  around  their  center,  hut 
D0  does  not.  Let  be  the  angular  displacement  of  Dx  as  it  rotates  around  its 
center,  for  i  =  1,2  We  set  the  angular  velocity  of  Dx  with  respect  to  Yu  to  be  the 
same  as  the  angular  velocity  of  with  respect  to  8  We  set  the  angular  velo¬ 
city  of  Dz  with  respect  to  to  be  32A  revolutions  per  time  unit  (see  Figure 
2). 

3  77 

We  assume  that  when  D  has  angular  displacement  0  =  — -  Dx  :s  posi¬ 
tioned  so  that  the  remaining  solid  quarter  section  of  Dx  completely  overlaps  the 
removed  quarter  section  of  D0  This  creates  an  immobile  "dead  space"  at 

3tt  1 

0  =  -r—  every  roughly  7—- time  units,  winch  B  cannot  cross  (because  its  velo- 

C  X  D 

city  is  too  small),  and  will  force  B  (if  it  is  to  avoid  collision)  to  exit  the  torus  via 
the  exit  slot  at  0  =  n  However,  while  D  has  angular  displacement  0, 

0  ^  9  <  n,  the  removed  3/4  section  of  D\  completely  overlaps  the  removed 
quarter  section  of  Dc  which  therefore  remains  completely  unobscured  (see  Fig¬ 
ure  3). 

Observe  that  for  0s9«  n  a  "free  space"  is  created  during  about  1/2 
revolution  of  Dz  around  its  center  (1  e.  when  the  removed  quarter  section  of  D0 
and  the  removed  half-section  of  D*  sufT'ripnriy  overlap  to  accommodate  B 
between  them),  and  B  can  be  located  in  this  free  space  without  contacting  an 
obstacle  On  the  next  roughly  1/2  revolution  of  L'z  around  'ts  center,  a  "dead 
^ -space"  is  created  (i.e  ,  when  the  removed  sections  of  discs  D0.  Dz  dc  not 
sufficiently  overlap),  and  B  cannot  be  located  in  this  dead  space  Since  D2 
rotates  around  its  center  at  most  2A  times  eve'y  time  interval  in  which  D 
rotates  through  the  torus,  at  most  2A  such  free  spaces  are  created  during  one 
revolution  of  D  around  the  torus  (see  Figure  4). 

Since  D  makes  an  integal  number  plus  revolutions  or  0  every  time 

unit,  each  free  space  moves  revolutions  of  9  ev  my  time  unit,  and  thus 

each  free  space  moves  1/2  a  revolution  of  0  in  A  time  units  as  required  in 
our  construction.  Moreover  we  have  chosen  the  size  of  the  torus  and  A>  1 0 .  so 
that  it  is  easy  to  verify  that  the  maximum  velocity  v  of  B  is  sufficient  for  B 
to  enter  the  torus,  to  move  along  within  a  free  spa^e  anc  to  finally  exit  the  torus 
Finally,  we  claim  that  B  cannot  move  between  any  two  distinct  free  spaces 
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while  in  the  interior  of  the  torus  If  this  was  possible,  then  B  could  move 

.  across  a  dead  space  without  colliding  with  D.  But  D  makes  a  revolution  of  3 

i 

at  least  every  r— -  time  units  In  this  time,  B  (which  has  maximum  velocity 


v)  can  move  at  most  distance  which  is  less  than  the  minimum  distance 

1  *  ^ 

r— -2n  =  ^-between  any  two  free  spaces,  a  contradiction 

4A  2rr  2 


Finally,  to  complete  cut  construction,  we  observe  that  it  is  easy  (by  use  of  a 
binary  tree  of  cylindrical  tube  obstacles  and  sweeping  semidiscs)  to  force  B  to 
move  from  the  exit  of  each  such  torus  to  pc.  so  that  the  overall  delay  in  reach¬ 
ing  Pc  is  A,  as  required.  A  description  of  the  above  construction  can  easily  be 
computed  by  an  0(log  n)  space  bounded  deterministic  Turing  Machine.  □ 


Remark:  This  "time-machine"  construction  can  be  simplified  further,  to  the 
case  involving  dynamic  movement  planning  in  2-L)  space  in  the  presence  of  a  s.n- 
gle  moving  obstacle  which  is  a  single  point  Giving  this  obstacle  a  rather  irregu¬ 
lar  (but  still  polynomially  describable)  motion,  w«  can  simulate  both  testing  dev¬ 
ices  and  delay  devices  and  any  additional  obstacles  needed  to  force  B  to  move 
from  and  back  to  the  starting  position  Pc  Nevertheless,  we  prefer  the  construc¬ 
tion  given  here  since  it  uses  more  natural  and  regular  kinds  of  motion  (We  are 
grateful  to  Jack  Schwartz  for  making  this  observation  ) 


3  EFFICIENT  AJXIORITHMS  FOR  THE  ASTEROID  AVOIDANCE  PROBLEM 


Our  PSPACff-hardness  result  of  the  previous  section  indicates  that  it  may 
be  inherently  difficult  to  solve  dynamic  movers  problems  where  the  obstacles 
rotate  Therefore  we  confine  our  attention  to  the  following  case,  which  we  call 
the  asteroid  avoidance  problem 


Assume  that  B  is  an  arbitrary  convex  polyhedron  in  d-space  which  can 
move  only  by  translating  with  maximum  velocity  modulus  v  but  without  rotat¬ 
ing  (so  that  its  motion  has  oniy  d  translational  degrees  of  freedom)  We  also 
assume  that  each  of  the  obstacles  is  a  convex  polyhedron  which  moves  (without 
rotating)  at  a  fixed  and  known  velocity  (which  may  vary  from  one  obstacle  to 
another)  Finally,  we  assume  the  obstacles  never  collide  with  each  other  The 
free  configuration  space  FP  (including  time  as  an  extra  degree  of  freedom,  as 
above)  is  ( d  +  l)-dimensional  While  the  case  i  =  1  is  easy  to  solve,  the  cases 
d  =  2,3  of  the  asteroid  avoidance  problem,  are  quite  challenging,  and  require 
some  interesting  algorithmic  techniques. 


We  have  efficient  algorithms  for  various  asteroid  avoidance  problems 
These  results  utilize  some  basic  facts  described  in  the  next  two  subsections,  of 
which  the  most  important  is  that  normal  movement  suffice 


3. 1  Reduction  to  the  Movement  of  a  Point 

Before  continuing,  we  use  the  following  simple  device  (see  (Lozano-Perez 
and  Wesley,  79])  to  reduce  the  problem  to  the  case  in  which  B  is  a  single  mov¬ 
ing  point  Let  B c  denote  the  set  of  points  occupied  by  B  at  time  t  =  0 
Replace  each  moving  obstacle  C  by  the  set  C  -  £?c  (which  consists  of  pomtwise’ 
differences  of  points  of  C  and  points  of  B0 )■  Suppose  that  we  wish  to  plan  an 
admissible  motion  of  B  from  the  initial  position  Bc  to  a  final  position  Bx.  and 
let  Xx  denote  the  relative  displacement  of  B\  from  B0  Then  such  a  motion 
exists  if  and  only  if  there  exists  an  admissible  motion  of  a  single  point  from  the 
origin  to  which  avoids  collision  with  the  moving  displaced  bodies  C  -  Bc 
(each  such  body  moving  with  the  same  velocity  as  the  obstacle  body  C)  Since 
the  displaced  bodies  are  also  convex  polyhedra  we  have  reduced  the  problem  to 


a  similar  one  in  which  B  can  be  assumed  to  he  a  single  moving  point. 
Hereafter  in  this  section,  we  assume  this. 

3.2  Normal  Movements 

We  will  require  some  special  notation  for  various  types  of  movement  of  B 
over  a  given  time  interval.  In  all  the  following  types  of  movement  of  B.  we 
allow  (the  point)  B  to  touch  an  obstacle  boundary,  but  do  not  allow  it  to  move 
to  the  interior  of  any  obstacle,  and  require  that  B  not  exceed  a  maximum  velo¬ 
city  modulus  v. 

(l)  A  static  movement  is  one  in  which  B  does  not  move  (i  e  ,  has  0  velocity) 

(3)  A  direct  movement  is  a  movement  of  B  with  a  constant  velocity  vector 
(with  modulus  £  v).  During  a  direct  movement,  B  may  touch  an  obstacle 
only  at  the  endpoints  of  that  movement. 

(3)  A  contact  movement  is  a  movement  of  B  in  which  B  moves  on  the  boun¬ 
dary  of  an  obstacle  C  (i.e . ,  the  boundary  of  the  region  of  FP  induced  by 
the  movement  of  C)  In  the  2 -D  asteroid  avoidance  problem,  we  also 
require  that  any  such  (maximal)  contact  movement  begin  and  end  at  (con¬ 
tact  with)  vertices  of  an  obstacle.  In  the  A-D  asteroid  avoidance  problem, 
we  require  that  each  contact  movement  begin  and  end  only  at  (contact 
with)  edges  or  vertices  of  an  obstacle. 

(4)  A  fundamental,  movement  cl  B  is  a  direct  movement  followed  possibly  by 
a  contact  movement. 

(5)  A  normal  movement  of  B  is  a  (possibly  empty)  sequence  of  fundamental 
movements  of  B  where  the  movements  must  satisfy  the  following  restric¬ 
tions: 

Rl:  Between  any  two  distinct  direct  movements,  there  must  be  a  contact  move¬ 
ment.  and 

R2:  No  two  distinct  (maximal)  contact  movements  are  allowed  to  vistf,  (the 
boundary  of)  ihe  same  obstacle. 

Note  that.  Rl  requires  that  a  normal  movement  does  hot  change  its  direc¬ 
tion  except  whiie  in  contact  with  an  obstacle  R2  ensures  that  abnormal  move¬ 
ment  consists  of  is  k  +  1  fundamental  movements,  where  k  is  the  number  of 
obstacles 

LFLMMA3. 1.  B  has  a  collision- free  movement  p  {t)  =  [X£,t  ]  from  [Ac.O]  to  [Xf.T ] 
iff  B  has  a  sequence  of  fundamental  movements  from.  [Aq.O]  to  [Xt,T]  satisfy¬ 
ing  RL 

Proof.  If  B  has  a  sequence  of  fundamental  movements  from  Xc  Oj  to  Xj-.T] 
y.  where  B  may  possibly  touch  some  of  the  obstacles,  then  since  the  obstacles 
are  assumed  never  to  collide,  and  the  initial  and  final  Dositions  of  B  are  free,  it 
is  easily  seen  that  by  a  perturbation  of  the  given  sequence  of  movements,  one 
can  obtain  a  collision-free  movement  from  [ 0]  to  [X7.T]. 


a 


For  the  converse  part,  consider  the  class  A"  of  ail  paths  p{t)  =  [Xt  .t  ]  in 
space-time  from  [.Yf.O]  to  [Ay, 7'],  whose  slope  at  any  given  time  is  of  modulus  at 
most  v.  and  which  avoids  penetration  into  the  interior  of  any  obstacle  By 
assumption  K  is  not  empty  Let  7V0  e.  K  be  the  shortest,  path  in  K  (where  the 
length  of  a  path  in  K  is  its  Euclidean  length  m  £’v'*1). 

Observe  that  if  rr  e  K  and  if  fAj.f  t],  [X?_,tz]  £  n.  then  the  path  n  .  obtained 
by  replacing  the  portion  of  rr  between  these  two  points  by  the  straight  segment 
joining  them  (in  space-time),  is  such  that  its  slope  at  any  given  time  is  ^  v 
Since  the  space-time  trajectory  of  each  obstacle  is  a  convex  polyhedron,  it  fol¬ 
lows,  using  standard  shortest -path  arguments,  that  rr0  must  be  a  polygonal  path. 
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which  consis.s  of  an  alternating  sequence  ;.>f  free  straight  segments  and  of  polyg¬ 
onal  subpalhs  in  which  B  >  in  contact  -. n  obstacle  Moreover,  the  vertices 
of  rrc  must  lie  along  edges  of  the  spai  a-iir.  - .■  ..rajectories  of  the  moving  obstacles. 
?o  they  correspond  to  contacts  cy  B  with  obstacle  vertices  Thus  rrc  is  a 
sequence  c  fundamental  movements  satisfying  Rl.  Q 

Lemma  8.2.  B  has  a  collision-/ ~ee  movement  from  [A'c,0]  to  [Xt,T]  iff  B  has  a 
no  ■  mat  movement  fro'n  Vc.Oj  to  [X f.T]. 

Proof.  By  Lemma  3.1,  we  can  assume  B  has  a  movement  [Xt,t]  defined  for 
0  ^  i  si  T.  consisting  of  a  sequence  ot  fundamental  movements  beginning  at 
times  .  tm  s'  T  satisfying  Rl.  If  restriction  R2  is  violated  then 

there  mu  A  be  times  tx,  tj  such  (A't  ,t  ]  is  in  contact  with  the  same  obstacle  C 
d  iring  times  tx  and  ty  But  since  C  is  convex,  its  trajectory  C*  in  spare-time 
is  also  convex.  It  is  then  easy  to  construct  a  single  contact  path  Xf.t  ]  along  C * 
for  tx<.  t  <  ty  such  that  Xtl‘  -  Xt.  and  Xt  ’  ~  Xtz,  and  such  that  the  slope  of  this 
;>a:h  af  .  ny  given  time  is  of  modulus  ^  u.  Repeating  this  process  as  required,  we 
get  a  norrnaiTricvement  satisfying  both  Rl  and  R2. 

The  other  direction  follows  from  Lemma  3.1.  Q 


U.3  The  Asteroid  Avoidance  ProbSem  *ilh  One  Degree  of  Freedom  cf  Movement 

VYe  wui  first  consider  the  case  of  a  i-D  asteroid  avoidance  problem,  where 
v,-e  assume  B  is  constrained  to  move  along  a  fixed  line  (in  th  presence  oi  2-D 
convex  polygonal  obstacles  which  can  pass  through  that  line)  The  problem  is 
not  difficult  in  this  case  since  B  has  only  one  degree  of  freedom  movement 
(Nevertheless,  a  brief  investigation  of  this  case  will  aid  the  reader  to  understand 
better-  the  techniques  which  we  use  for  the  more  difficult  cases  of  d  =  2,3 
degrees  of  freedom.)  Let  n  be  the  total  number  of  obstacle  edges  Let  k  be 
the  number  of  obstacles.  By  the  reduction  of  Section  3. 1.  we  can  assume  B  is  a 
s'ngie  pemt. 

THEOREM  3.1.  The  asteroid  avoidance  problem  can  be  solved  in  time  0{n  leg  n) 
If  3  is  constrained  to  move  only  along  a  1 -dimensional  line  L 

lYoof.  The  key  observation  is  that  the  (space-time)  configuration  space  FP  in 
this  case  is  a  2-dimensional  space  bounded  by  polygonal  barriers  generated  by 
the  uniform  motions  along  L  of  the  intersections  of  obstacle  edges  with  L  We 
explicitly  construct  FP  using  a  scan-line  technique.  We  first  sort  in  tim« 
0 ( n  log  71 }  all  ub-iLricie  edges  and  vertices  in  the  order  of  times  in  which  they 

first  intersect  L.  Let  this  sorted  sequence  be  £; . (where  m  -  Q[r,.))  As 

we  sweep  the  s^an  Lire  across  time,  we  maintain  fer  each  time  t  the  sot  FP-.  of 
all  accessible  free  configurations  at  time  t ,  and  also  a  sorted  Lsr.  Q  of  the  inter¬ 
sections  of  obstacle  edges  with  L  at  time  t.  Suppose  (Afc,0j  is  the  initial 
configuration  of  B.  Initially  FPC  consists  of  the  single  point  [ Jfc,0]  in  space- 
time,  and  the  initial  value  of  Q  is  easily  calculated  in  time  0(n  log  n )  Induc¬ 
tively,  suppose  for  for  some  tx  >  0  we  have  constructed  FPti  We  represent 
FPti  as  an  ordered,  finite  sequence  of  disjoint  intervals  /,.  .  .  , /,  of  L.  whose 

union  is  the  set  of  all  points  X  such  that  there  is  a  c  ollision-free  movement  of 
B.  whose  velocity  modulus  never  exceeds  v .  from  (A'o.O]  tolA'.f,]  Let  £lfl  be 
the  next  time  following  h  that  an  obstacle  vertex  intersects  L  FP,  can 
easily  be  constructed  from  FPt  by  observing  that  (1)  the  boundaries  ot  each 
of  the  intervals  I}  expand  with  velocity  v ,  and  (2)  an  obstacte  deletes  any  por¬ 
tion  of  an  interval  I}  that  it  intersects  on  the  line  L.  moreover,  this  intersection 
is  itself  an  interval  (since  the  object  is  convex)  whose  endpoints  move  with  con¬ 
stant  velocities  for  t  in  the  interval  [tx.ti,  i] 


',%*■  ;  *p~r  --  •*  •  * 
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From  (2)  it  follows  that  the  tq£al  number  of  intervals  ever  inverted  by  the 
algorithm  into  L  is  at  most  Zk  jC  0(n).  Each  step  in  the  construction  of  FPt <+1 
from  FPt  can  thus  create  a  new  interval  in  >■  change  the  velocity  of  an  end’ 
point  of  such  an  interval  already  in  L.  and  optionally  also  merge  pairs  of  such 
adjacent  intervals  into  single  intervals.  But  the  overall  number  of  such  merges 
cannot  exceed  the  number  of  intervals  ever  inserted  into  L,  i.e.  is  at  most  O(n). 
The  total  time  of  the  algorithm  is  therefore  0(n  log  n)  Q 

3.4  A  Polynomial  Tune  Algorithm  fcr  the  2-D  Asteroid  Avoidance  Problem  for  a 
Bounded  Number  of  Obstacles 

In  this  subsection,  we  consider  the  2-D  asteroid  avoidance  problem.  The 
configuration  space  FP  in.  this  case  is  3-dimensional  We  can  assume,  oy  the 
reduction  of  Section  3.1,  that  B  is  a  single  point.  We  wish  to  move  B  from 

^o.O]  to  [ Xf.T]  The  obstacles  C\ . Ck  are  k  convex  polygons  Let  n, 

the  size  of  the  problem,  be  the  total  number  of  vertices  and  edges  of  the  obsta¬ 
cles.  Wc  will  show  that  if  k  is  a  constant,  then  we  can  solve  the  problem  in 
n0(1)  time. 

Our  basic  technique  will  be  tc  first  consider  the  problem  of  computing  the 
time  intervals  in  which  single  direct  and  contact  movements  can  be  made,  and 
then  use  a  recursive  method  tc  determine  the  time  intervals  in  which  it  is  possi¬ 
ble  to  do  normal  movements. 

For  technical  reasons,  we  consider  the  initial  and  final  positions  of  B  to  be 

additional  immobile  "obstacles”'  Cc  ~  Af0.  ck*  i  -  X r .  each  consisting  of  a  single 

vertex.  Let  V(C.)  be  the  set  of  vertices  of  obstacle  C,  fcr  j  -  i,  .  .  k  and 

1  k<  i  J 

let  K(C0)  =  {A'o}  and  V{Ck^)  =  \XT\.  Let  V  =  u  V{C,)  be  the  set  of  all  ver- 

j  ~c 

tices  Note  that  for  each  j  =  0 . k  + 1,  all  vertices  a  e  F(C;)  undergo  a 

translational  motion  with  the  name  fixed  velocity  vector. 

We  will  use  /  to  denote  the  set  of  times  a  certain  event  will  occur  Let  i /  ■ 
denote  the  minimum  number  of  disjoint  intervals  into  which  the  points  of  I  can 
be  partitioned  Clearly.  /  can  be  written  using  0{  J  I)  inequalities  We  will 
store  the  intervals  of  /  in  sorted  order  using  a  balanced  binary  tree  of  size 
0[  ’  /  ;).  in  which  we  can  do  insertions  and  deletions  in  time  c?(log  /  : ). 

For  each  a.  a'  e  V(i7;),  let  C/Aa  „  (/)  be-  the  set  of  all  times  t'  0  for  which 
vertex  a’  can  be  reached  at  time  t'  by  a  contact  movement  of  B  on  the 

boundary  of  C}  starting  at  vertex  a  at  some  time  l  e  /. 

Lemma  3  3.  CM^a(i)  can  be  computed  in  time  0\  j  +  ,  V{C} )  )  ana.  further¬ 
more  i  CMa  p  { I )  1  5  |  /  i . 

Proof.  There  are  fixed  reals  0  s,  A]  ^  A?  f  possibly  infinite)  such  that  vertex  a' 
can  be  reached  from  vertex  a  by  a  contact  movement  within  mnurnum  delay  A, 
and  maximum  delay  A3  These  delay  parameters  A,.AZ  can  be  easily  computed 
fby  computing  the  sum  of  trie  deiay  bounds  required  for  near-contact  movement 
of  each  of  the  edges  of  C,  from  a  to  a')  in  time  0[  V[C})  ,)  then 

t'Wa>uv')  =  1 1  i  Aj  +  i  t  £  Az '+  i .  f  r.  /  j  . 
so  CMa  „■(/)  I  ■£>  |  /  1 ,  and  can  be  computed  within  time  +  iV'(C’j)i).  Q 

For  each  a, a'  c  V,  let  L)!Aa  a  {I)  be-  the  set  ci  all  time:  i  s.-  0  such  that  ver¬ 

tex  a'  can  be  reached  at  time  t  by  a  single  direct  movement  of  B  starting  at 
vertex  o-  at  some  time  t  c  / 

To  ca’culate  BiA„  u( l).  we  consider  the  following  sunproblcm.  Find  the  sot 
hc  a  of  all  pairs  of  times  l.  ,  t '  such  that  the  pos't’on  a'[l)  of  a'  at  time  t'  can  be 
reached  from  the  position  cf  a  ot  time  t  by  a  singl.*  direct  movement 
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Fix  a  time  t  and  let  A[t)  denote  the  set  of  all  times  f '  such  that  the  slope  of 
the  motion  from  [a(£),£]  to  [a'{t'),t]  has  modulus  ■&  v .  Plainly  >4(t)  is  a  closed 
interval  [ i i . r s ] -  Consider  the  triangle  A  whose  corners  are  u>  ~'a{t),t], 
u,,  =  [a‘(*i),fi].  wz  --  [a{tz).t2]  For  each  obstacle  Cj .  its  space-time  trajectory 
C*  intersects  A  at  a  convex  set  Aj  The  two  tangents  from  w  to  A ;  cut  an  interval 
Aj{t)  of !  the  segment  Aj{t)  is  exactly  the  set  of  positions  [a'{t'),t']  of  n' 

which  are  not  reachable  from  'a(t).^]  by  a  single  direct  movement,  due  to  the 
interference  of  Cj  Let  /;(£)  denote  the  projection  of  Aj[t)  onto  the  f-axis  The 
set  r0,a-  is  then 

{{t.C)  :  C  l  S  Ij(t)\ 

Suppose  Fa  a  has  been  calculated  Then 

DMa.a  =  \t  :  e  /.  [t.f)  d  Fa. a- j  ■ 

To  calculate  the  two-dimensional  set  Fa  a  we  can  use  a  standard  technique  of 
sweeping  a  lire  t  =  const  across  the  (£,£')-plane  Note  that  for  each  t  and  j. 
each  endpoint  of  /,(£)  is  determined  by  a  specific  vertex  of  Cj.  and  that,  given 
such  a  vertex  v  the  corresponding  endpoint  ev {t)  of  1) ( t )  is  an  algebraic  func¬ 
tion  in  t  of  constant  degree  Hence  the  structure  of  Faor\ft  =  const]  can 
change  during  the  sweeping  only  at  points  t  where  two  functions  e„(f).  ev(0 
overlap,  or  where  one  such  function  has  a  vertical  tangent,  i  e.  at  0[n2 )  points  ac 
most  This  readily  implies 

Lemma  3.4:  Fa  a  can  be  calculated  in  time  0{n2[ogn),  and  stored  in  C(n2) 
space  Furthermore .  for  each  1,  [DMaa-{I),  •&].!.  +  n2)/c.  and  DI.ia  „(/)  can  be 
calculated  in  time  ( ;  /  +  n2)fc 

Proof:  The  first  part  follows  by  the  sweeping  technique  mentioned  above  The 
second  part  follows  from  the  fact  that,  as  a  result  of  the  sweeping,  the  t- axis  *s 
split  into  0{n?)  intervals,  over  each  one  of  which  the  combinatorial  structure  of 
Fa  a  "emains  constant,  and  consists  of  at  most  k  +  1  disjoint  intervals.  Hence, 
merging  these  intervals  with  the  intervals  of  I .  we  can  calculate  DMa  a  {!)  m  a 
straightforward  marine*'  within  the  asserted  time  bound,  and  also  obtain  the 
required  bound  on  the  complexity  of  that  set.  □ 

THEOREM  3.2.  7 he  asteroid  avoidance  problem  can  be  solved  in  time 

0{nz'k and  h  - nee  in  time  in  the  case  of  k  =c?(l)  obstacles 

Proof.  Initially  let.  -  \t  .0  ^  t  <  and  let  -  <f>  for  each  a  d  v  -  |,YcJ 
Inductively  for  come  i  i  0,  suppose  for  each  a  dv.  /a'l)  is  the  set  of  times  t 
that  vertex  a  is  reachable  from  ’A^.O]  by  a  (collision-free)  movement  of  B 
consist. ng  oT  -a  i  fundamental  movements  Then  for  each  a’  e  V’, 

Jd})  =  U  D'.ia, „•  (/j'>) 

acV 


is  the  set  o',  times  that  vertex  a'  is  reachable  from  LYc,0]  by  a  movement  of  B 
consisting  of  ii  fundamental  movements  followed  by  a  direct  movement 
Hence  if  a"  d  K(C,)  then 

/i?M>  =  U  CMa-.a"{Jp) 

•■cy;  ct) 

is  the  si-t  of  times  that  vertex  a"  is  reachable  from  ’A"c.O]  by  a  movement  of 
B  consisting  of  si  +  ;  fundamental  movements  Thus  for  each  a  d  V.  is 

the  set  of  times  vertex  a  is  reachable  by  a  normal  movement  of  B  from 
■  A'c.O]  Hy  Lemma  3  2  such  a  normal  movement  suffices  So  T  d  iff  there 
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exists  a  collision-free  movement  of  B  from  ’_A'C  0]  to  \Xj.T]. 

Lemmas  3  3  and  3.4  imply  s  0{nZi*2k)  and  so  the  i-th  step  takes 

time  0{nz{nZx*zk  \og{nZx**k))).  Therefore,  the  total  time  is  0(n^fc+z)fc).  Q 


3.5.  A  Decision  Algorithm  for  the  3-D  Asteroid  Avoidance  Problem  with  an 
Unbounded  Number  of  Obstacles 

We  next  consider  the  3-D  asteroid  avoidance  problem.  The  configuration 
space  FP  is  in  this  case  4-dimensional.  By  the  results  of  Section  3.1,  we  can 
assume  we  wish  to  move  a  point  B  from  ’A'c.O]  to  [Xj.T].  avoiding  k  convex 
polyhedral  obstacles  Clt  ...  Ck.  in  this  case  the  size  n  of  the  problem  is  the 
total  number  of  edges  of  the  polyhedra  We  will  show  that  the  problem  is  decid¬ 
able. 


Recall  that  each  contact  movement  is  required  to  begin  and  end  at  an  obs¬ 
tacle  edge  or.  vertex.  We  will  consider  each  obstacle  edge  e  ~[u,v)  to  be 
directed  from  u  to  v .  If  e  has  length  L  we  will  for  0«y«;:.  let  e(y)  denote 
the  point  on  a  at  distance  y  L  from  vertex  u,  so  e  (0)  =  u  and  *(i)=v. 
Let  £  =  {e,.  .  .  .  ,  enj  be  the  set  of  all  obstacle  edges.  Let  E{Cj)  C E  be  the  set 
of  (directed)  edges  of  obstacle  C}  for  j  =  i,  .  .  .  fc. 

For  technical  reasons  we  again  consider  the  initial  and  final  positions  of  B 
to  be  immobile  obstacles  C0  =  )'a  and  Ck  +  x~XT.  We  consider  E{Cf)  to  con¬ 
tain  a  single  edge  of  length  0  at  point  Xc  and  £‘(Ct  +  1)  to  contain  a  single  edge 
of  length  0  at  point  Xj. 


An  open  formula  F(y  t,  .  .  .  ,yr)  in  the  theory  of  real  closed  fields  consists 
of  a  logical  expression  containing  conjunctions,  disjunctions,  and  negations  of 
atomic  formulas,  where  each  atomic  formula  is  an  equality  or  inequality  involv¬ 
ing  rational  polynomials  in  the  variables  yi . yT  A  (partially  quantified)  for¬ 
mula  iri  this  theory  is  £  formula  of  the  form  Q y ,  QaVa  F{yl  yr)  where 

a  <:  r .  and  where  each  Ql  is  an  existential  or  a  universal  quantifier  Such  a  for¬ 
mula  will  be  called  an  algebraic  predicate;  its  degree  is  the  maximum  degree  of 
any  polynomial  within  the  formula,  and  its  size  is  the  number  of  atomic  formu¬ 
las  it  contains.  We  will  use  the  following  results: 

LEMMA  3.5  [Collins.  75],  A  given  formula  of  the  theory  of  real  closed  fields  of 
size  n,  constant  degree,  ivith  r  variables  cun  be  decided  in  deterministic  time 
nz°{r). 


uEMMA  3.6  [Ben-Or,  Kczen,  and  Reif,  04]  A  given  formula  of  the  theory  of 
to  nf  closed  fields  of  jtIzs  v.  c  o  tl  s  ?  ci  *1  t  d°£ tqz  ov.d  t  vo.vio.blQs  c ovt  bs  dQcidzd  ivt 
space 

We  will  first  show  that  we  can  describe  by  algebraic  predicates  the  time 
intervals  for  which  fundamental  movements  can  be  made,  and  then  use  the 
existential  theory  of  real  closed  fields  to  decide  the  feasibility  of  movements 
consisting  of  fimte  sequences  of  these  fundamental  movements.  Below  we  fix 
et.  e.  e  £(Cj)  and  0^y.y'<  1  Let  cm{i.i  y. y'.A)  be  the  predicate  which 
holds  just  if  B  has  a  contact  movement  along  a  single  face  of  Cj  from  et(y)  to 
et  (y)  with  delay  A  (l  e  the  motion  takes  A  time  units) 

LEMMA  3.7  cm{i,i\y, y  '.A  )  can  be  constructed  in  polynomial  time  as  an  a Ige- 
brau.  predicate  of  size  n°W  u/ith  constant  degree  and  no  quantified  variables 

Proof.  Let  /ace(i.i’)  be  the  predicate  that  holds  iff  et  and  e;,  are  both  on 
the  same  face  of  an  obstacle.  Let  [u;x,-wl/ ,wt)  be  the  velocity  vector  of  obstacle 
Cy  Let  [us  ,u3)  be  distance  vector  from  e,(y)  to  e,(y').  where  Ux.Uy.u, 
are  vail  linear  functions  of  y,y'  3  will  move  in  contact  with  C,  with  velocity  vec¬ 
tor  (v, .vy.o3)  with  modulus 
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>/v]  +  Vy+Zg  ^  V  . 

If  B  moves  from  et(y)  to  ex(y')  with  delay  A  then  we  must  have 
vt  A  =  wx  A  +  ur ,  vv  A  =  wy  A  +  iLy  ,  and  v,  A  =  u.,  A  +  u,  . 

Solving  for  .v,  and  substituting  into  u'f  +  v y  u/,  we  derive  the  for¬ 

mula 


cm{i,i'.y , y  '.A)  s 


A+Uj 

A 


WyL  +  Uy 

A 


vijA+u, 

A 


A  /ace  (i.i  ) 


Let  dm  (i.i'.y  ,£  )  be  the  predicate  which  holds  just  if  B  has  a 

(collision-free)  direct  movement  from  ex(y )  at  time  f,  to  ex(y)  at  time  £'. 
The  following  is  proved  using;  arguments  similar  to  those  used  in  Lemma  3.4. 

LEMMA  3.8  dm(i.i'.y  ,y',t ')  can  be  constructed,  in  polynomial  time  as  a r 
algebraic  predicate  of  size  and  degree  n0'^  with,  na  quantified  variables 

Proof.  For  a  given  set  of  obstacles  C  q\C  i . C*}  let  dm(fi  ,i' ,y  ,y '  ,t  ,t)  be 

defined  as  above,  except  that  we  allow  possible  collisions  of  B  with  obstacles  in 
JCj.  .  .  .  ,  C*}  -  C  T.ten  dm^(i ,i',y  ,y‘,t ,t  )  can  easily  be  given  as  an  algebraic 
predicate  of  size  n bounding  the  time  f  to  a  single  (possibly  empty)  inter¬ 
val.  whose  bounds  vary  algebraically  with  t . 

Inductively  we  can  write  dmjfl  qj  {i.i’  y  ,y'  i  ,*')  as  the  conjunction  of 
dm\cv  c,  t|  (i.i' ,y  .y' ,t  ,t ')  and  an  algebraic  predicate  of  size  n°^\  restrict¬ 
ing  t'  outside  a  single  (possibly  empty)  interval  of  time  Thus 
dm  (i.i'.y  ,y  ,t  ,t  ’)  =  dm^c  c  j  (i  ,i',y  .y'.t  ,t ')  is  an  algebraic  predicate  of  size 
n°< ». 

Let  fm(i,i',y  ,y',t  ,t)  hold  iff  there  is  a  fundamental  movement  of  B 
from  ex(y)  at  time  t  to  ex(y)  at  time  £'.  Lemmas  3.7  and  3. B  imply 

fm(i,i',y,y',t,t')  =  dm  (i.i'.y.y'.t.t)  V  cm(i,i',y  y t ) 

ft 

v3i".y",A  dm{i  ,i"  ,y  ,y"  ,t  ,t'  —  A)  a  cm(i",i',y  "  ,y  ,A) 


LEMMA  3  9  fm{i,i  y  y  t  t ')  ran.  be  constructed  in  polynomial  time,  ns  an 
algebraic  predicate  of  size  n0'1^,  constant  degree  and  0(1)  quantified  vari¬ 
ables. 

Let  m  [i.i’.y  y  ,t  ,t ')  be  the  predicate  that  holds  iff  B  'has  a  collision-free 
movement  from  e^y)  at  time  t  to  e,( y)  at  time  t‘.  Note  that  the  formula 
for  m(i,i‘,y  ,y \t.  ,t ')  appears  to  require  0(n)  quantified  variables.  We  now 
show 

LEMMA  3.10.  m(i.i',y.y  ,£,£')  can  be  constructed  in  polynomial  time  as  an 
algebraic  predicate  of  size  n^1)  with  constant  degree  using  £?(log  n) 
quantified  variables. 

Proof.  For  each  t  =  0,1,  .  .  ,logn,  we  define  mtr>  (i.i'.y.y'.t  ,t  )  to  be  predi¬ 
cate  that  holds  iff  B  has  a  movement  from  et(y)  at  time  t  to  e.  (y')  at  time 
t'  consisting  of  a  sequence  of  ^  2^  fundamental  movements.  Clearly, 
m.'c^  (i  ,i',y  ,y  ',£,£')  =  fm(i,i',y,y.t.t)  We  can  then  define 

[i.i'.y  ,y',t  ,t  )  =  3  i',y ",t  " 
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TO'^  (i  ,i'  ,y  ,y'.t  ,t  ")  a  ')  . 

However,  this  definition,  when  applied  recursively  yields  a  formula  of  size  Zn . 
A  more  compact  definition  is  gotten  by 

(i.i'.y.y'.M)  =  ,.02,03,04,03,06 

>1  =  i  a  a j  =  i "  a  a3  =  y  a  a4  =  y"  a  a5  =  t  ,\a6  ~  t ")  v 
(ai  “  *"  a  a2  =  i'  a  a3  =  y "  a  a4  =  y'  a  a5  =  f "  a  ae  -  f ')] 


o 


m 


m 


(«i 


,dg,ag,  04,05,  tig) 


The  formula  m^0®  n)  [i.t'.y  ,y  ',£  ,t)  is  of  size  nc'(1)  log  n  s  n0(1)  and  requires 
only  0(log  n)  quantified  variables.  By  Lemmas  3.1  and  3.2  we  have 
m{i.i'.y  y.t  .£')  =  m(loin)  (i.t'.y  ,y \t  ,t ').  □ 

THEOREM  3.3.  7'he  3-0  a steroid  avoidance  problem,  can  be  solved  in  time  2nt>(1), 
or  aJ lematively  in  space 

Proof.  We  assume  immobile  obstacle  edges  ej.ej  such  that  e,(0)  =  A'0  and 
c2\0)  =  Xj  Hence  by  Lemma  3.10,  D  has  a  collision-free  movement  from 
[A'c.O]  to  \Xt,T]  iff  mf  1,2, 0,0,0,  T)  holds. 

Since  m  (i, 2. 0,0,0,  T)  has  size  and  0(log  n)  variables,  we  can  test 

satisfiability  of  m  ( 1,2, 0,0,0,  T)  by  Lemma  3.5  in  time  2nC>('\  or  alternatively  by 
Ler  inia  3  6  in  space  n0'10®"5.  □ 


3.6  The  3-D  Asteroid  Avoidance  Problem  with  Slow  Obstacles 

Let  be  the  maximum  velocity  modulus  of  any  obstacle,  and  let  v 

denote  as  above  the  maximum  velocity  modulus  of  B  The  sloiv  asteroid 
avoidance  problem  15  a  restricted  3  D  asteroid  avoidance  problem  where  we 
require  v;ni41Sv.  and  we  wish  to  plan  an  admissible  mi  tion  of  B  winch  will 
avoid  collision  with  any  of  the  moving  obstacles  within  a  given  interval  of  time. 
That  is,  we  do  not  specify  a  final  desired  position  of  B  but  are  only  interested  in 
the  ability  of  B  to  avoid  collision  with  slowly  moving  obstacles 

Let  C  be  one  of  the  moving  obstacles  whose  velocity  is  il  Then  the  space- 
,>'time  volume  swept  by  C  is 

C*  =  \[Y+wt.t  ]  :  re  Cc.t  ;>  0} 

where  C0  is  the  volume  occupied  by  C  at  time  t  -  0.  Hence  C*  is  also  a  con¬ 
vex  body  Next  define  the  shadow  of  C  to  be 

s(C’)  =  ^A',t]:Vjii;^f9T>-0,'A'  +  TU,<+T]eC*J  . 

In  other  words,  s(C)  consists  of  points  [ X, £  ]  such  that  if  we  proceed  from 
them  at  any  fixed  admissible  velocity,  we  will  encounter  a  point  on  C*.  The 
intuition  behind  this  definition  is  that  s(C)  contains  space-time  positions  from 
winch  it  is  impossible  to  escape  the  moving  C,  using  any  fixed  admissible  velo¬ 
city  The  fo.lowing  lemma  shows  that  we  cannot  escape  from  any  of  these  points 
under  any  choice  of  varying  (but  admissible)  velocity: 


LEMMA  3.11.  For  each  Z  e  s(C),  any  path  starting  at  Z  whose  pointwise  velo¬ 
city  remains  bounded  by  v  will  hit  a  point  in  C*. 

Proof.  Suppose  the  contrary,  and  let  p  be  such  a  path  which  misses  C*. 
Without  loss  of  generality  we  can  assume  that  p  is  a  polygonal  path  (so  that 
along  each  segment  of  this  path  the  velocity  is  constant).  Consider  the  first  seg¬ 
ment  of  p  connecting  a  point  AY^i]  in  s(C)  to  a  point  [A"2,£2]  outside  s(C), 
and  suppose  that  the  velocity  along  this  segment  is  u  In  particular 

A'a  =  Ah  +  (f2  -tx)u  . 

Since  [A'j.f  i]  £  s(C).  and  since  u  is  an  admissible  velocity,  there  e”  sts  a  time 
r  (necessarily  larger  than  £2)  such  that 

Wt  =  [Ah  +  ( t  -  t  Ou.t]  e  C*  . 

On  the  other  hand,  [A'2,f2]  is  not  in  s(C)  so  that,  by  definition,  there  exists 
another  admissible  velocity  u0  so  that  the  straight  path  pc  going  from  [X2,t2] 
at  velocity  u0  never  meets  C*.  By  the  same  argument  used  above,  there  also 
exists  a  time  To>fi  such  that 

ft's  =  (At  +  (to  —  fi)^0'To]  e  C*  ■ 

But  C*  is  convex,  so  that  the  whole  segment  connecting  with  Wz  must  be 
contained  in  C*.  This  however,  is  impossible,  because  this  segment  intersects 
p o,  a  contradiction  which  proves  our  claim,  n 

LEMMA  3.12.  Let  Ch  and  C2  6e  two  distinct  moving  obstacles  -with  velocity 
modulus  Sv.  77ien  s  (C,)  n  s  (C2)  -  0. 

Proof.  Suppose  the  contrary,  and  let  Z  =  [A\t]  be  a  point  in  s(Ch)  r\s(C2) 
Choose  any  admissible  velocity  it,  and  proceed  from  Z  at  velocity  it  Since 
Z  belongs  to  both  shadows,  it  follows  that  there  exist  times  Tj,  to,  both  larger 
than  t.  such  that  Zx  -  [A>ii (r,-* ),Tj]  e  Cf  and  Z2  =  [A>i'.(t2-£  ),r2]  £  C2* 
Without  loss  of  generality  assume  Ti  <  r2.  Then  by  the  proof  cf  Lemma  3  11  we 
have  Z\  e  s(C2).  But  Z\  is  a  point  on  the  moving  Cj,  which  implies  that  a 
point  on  will  eventually  meet  C2.  which  contradicts  our  assumption  that 
the  moving  obstacles  do  not  collide.  □ 

THEOREM  3.4.  If  w v  and  the  initial  position  of  B  is  not  m  any  shadow 
s[C)  then  it  is  always  possible  for  B  to  avoid  collision  with  the  moving  obsta¬ 
cles  Furthermore ,  if  the  obstacles  are  k  polyhedra  u/ith  a  total  of  n  edges, 
then  the  required  motion  of  B  can  be  computed  in  time  (n  +k)c'^  ~  n°'xi\ 

Proof.  Let  A'c.O'l  be  the  initial  configuration  at  time  £c  =  0. 

It  suffices  for  B  to  remain  immobile  for  f  &  0,  as  long  as  contacts 

no  obstacle  shadow.  Let  t '  &  0  be  the  first  time  (if  ever)  that  [X^.t  ]  contacts 
an  obstacle  shadow  s{C).  Let  w  be  the  velocity  vector  of  C  During  times  £. 
t'  t  <.  «>,  we  give  B  near-contact  motion  which  remains  on  the  external  boun¬ 
dary  of  s(C)  using  only  translation  of  velocity  In;  in  the  direction  of  w 
Since  wmtxsv,  the  velocity  modulus  of  these  movements  do  not  exceed  v . 
Thus  we  have  established  the  existence  of  a  collision-free  movement  [X.t]  for 
0  Hence  B  can  always  avoid  collision  with  any  obstacle  Since  the 

shadows  of  3-D  polyhedral  obstacles  can  be  easily  computed  in  polynomial 
time,  the  required  collision-free  motion  can  also  be  computed  in  polynomial 
time  Q. 

4,  DYNAMIC  MOVEMENT  PROBLEMS  WITH  UNRESTRICTED  VELOCITY 

Throughout  the  last  two  sections  we  have  assumed  B  had  a  given  velocity 
modulus  bound.  Here  we  will  allow  B  to  ha  re  unrestricted  motion,  and  in 


-  17  - 


„  particular  we  will  impose  no  velocity  bounds. 

This  case  appears  still  intractable,  as  we  show  that  the  3-D  dynamic  move¬ 
ment  problem  for  the  case  B  is  a  cylinder  with  unrestricted  motion,  is  NP~ 
hard.  Again  this  proof  requires  that  b  has  only  0(1)  degrees  of  freedom  and 
we  make  critical  use  of  the  presence  of  rotating  obstacles  to  encode  time. 

We  will  next  show,  in  contrast  with  what  has  just  been  stated,  that  the  prob¬ 
lem  is  polynomial  time  if  all  the  obstacle  motions  are  algebraic  in  space-time, 
that  is  the  movement  of  B  is  constrained  by  algebraic  inequalities  of  bounded 
degrees  (for  example  B  consists  of  a  bounded  number  of  3-D  linked  polyhe- 
dra),  and  there  is  no  bound  on  the  velocity  modulus  of  B . 


4.1  The  Case  of  Unrestricted  Motions  in  the  Presence  of  Rotating  Obstacles  is 
NP-hard 

We  will  reduce  the  3-satisfiability  problems  to  that  of  planning  the  motion 
of  a  cylindrical  body  B  in  3-space  in  the  presence  of  several  rotating  obsta¬ 
cles.  A  semidisc  is  a  disc  with  half  its  interior  removed  so  that  it  is  bounded  by 
a  semicircle  and  a  line  segment.  Suppose  that  we  are  given  an  instance  of  3- 
satisfiabihty  involving  n  Boolean  variables  x,,  .  .  .  .  xn.  With  each  variable  xx 
we  associate  several  semidiscs  Dx  k  of  radius  1.  each  rotating  in  some  plane 
lying  parallel  to  the  x~y  plane  at  some  height  h,  t  with  its  center  at  some 
point  wxk  For  each  i  =  1 . n,  all  the  semidiscs  Dx,k  rotate  with  the  same 

angular  velocity  vx  -  ^  .  Thus  the  first  set  of  semidiscs  complete  half  a  revo- 

lution  in  1  time  unit,  the  second  set  in  2  time  units,  and  so  forth.  Hence,  if  U 
is  a  sufficiently  small  disc  contained  in  the  interior  of  the  2-D  unit  disc  near  its 
perimeter,  and  if  the  initial  positions  of  the  rotating  semidiscs  are  chosen 
appropriately,  then  after  t  whole  time  units  each  semidisc  Di  k  will  cover  the 
set  {U  +  wxJc)  x  if  and  only  if  the  i-th  binary  digit  of  t  is  1.  We  assume 

that  the  cross  section  of  B  has  an  area  smaller  than  that  of  V 


Suppose  that  the  given  instance  of  3-satisfiability  involves  p  clauses, 
where  the  m-th  clause  has  the  form  zm<  v  zm?  v  zm  where  each  zt  is  either 
x,  or  the  complement  of  x, .  We  represent  this  clause  by  three  semidiscs 
,Dmt  m^m3.rn-  all  placed  on  a  plane  at  some  height  hm  (without  touching  or 
intersecting  each  other),  such  that  their  centers  all  he  on  the  y  axis  of  this 
plane,  and  such  that  the  empty  half  of  Dm  m  is  placed  initially  to  the  right  of 
the  y- axis  if  zmi  =  xmi;  otherwise  the  semidisc  is  placed  initially  with  its  empty 
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necting  seme  point  Cm  lying  between  the  (m.-l)-th  plane  and  the  m-th  plane 
-'just  introduced,  to  a  point  Cm  u  lying  above  the  new  plane  Each  tunnel  is  cir¬ 
cular,  and  its  intersection  with  the  plane  is  a  sufficiently  small  disc  lying  within 
the  right  half  of  the  corresponding  disc  D  near  its  highest  (in  y )  point  This 
construction  implies  that  at  time  t  the  body  B  that  we  wish  to  move  can 
quickly  go  from  C,n  to  iff  the  assignment  of  the  i-th  binary  digit  of  i  to 

the  variable  xx,  for  each  i  =  1,  .  .  .  ,n,  satisfies  the  m.-th  clause.  It  follows  that 
we  can  move  3  from  an  initial  position  C,  to  a  final  Cm>  j  iff  there  exists  a 
time  t  for  which  the  above  assignment  satisfies  the  given  instance  of  the  3- 
satisfiabihty  problem.  (It  is  easy  to  add  more  rotating  discs  tm  t  would  enforce 
B  to  traverse  the  whole  system  of  tunnels  in  a  very  short  time  that  begins  at  an 
integral  number  of  time  units.)  This  proves  that 


THEOREM  4.1.  In  the  presence  of  rotating  obstacles,  dynamic  motion  planning 
of  a  ‘  cdy  B  with  no  velocity  modulus  bound  is  NP-hard,  even  in  the  case  where 
the  body  B  is  a  rigid  cylinder. 
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Remark:  As  in  the  case  of  the  time-machine  construction  in  Section  2,  this 
construction  can  also  he  simplified  to  a  two-dimensional  dynamic  movement 
planning  with  a  single  moving  point  obstacle,  at  the  cost  of  using  an  irregular 
and  more  complex  motion  of  that  obstacle 

4.2  The  Case  of  Unrestricted  Algebraic  Hotion3 

Let  8  be  an  arbitrary  fixed  system  of  moving  bodies  with  a  total  of  d 
degrees  of  freedom  Let  S  be  a  space  bounded  by  an  arbitrary  collection' of 
moving  obstacles  Let  the  (space-time)  free  configuration  space  FP  of  8  be 
defined  as  m  Section  1  We  will  assume  that  the  problem  is  algebraic  in  the 
sense  that  the  geometric  constraints  on  the  possible  free  configurations  of  B 
(l  e  ,  the  constraints  defining  FP)  can  be  expressed  as  algebraic  (over  the 
rationals)  equalities  and  inequalities  in  the  d  +  1  parameters  \X,t). 


Remark.  Some  of  the  motions  used  in  the  preceding  lower  bound  proofs 
are  not  algebraic  in  the  above  sense.  The  simplest  such  motion  is  rotation  of  a 
two-dimensional  body  about  a  fixed  center.  Indeed,  suppose  for  simplicity  that 
the  rotating  body  is  a  single  point  at  distance-  r  from  the  center  of  rotation 
(which  we  assume  to  be  the  origin).  Then  the  curve  in  space-time  traced  by  the 
rotating  point  is  a  helix,  parametrized  a?  vx,y,t)  =  (r  cos  ot  ,r  sin  ut.,t).  which 
is  certainly  not  algebraic 

To  obtain  a  polynomial-time  solution  to  this  problem,  we  decompose  Ed¥X 
into  a  cylindrical  algebraic  decomposition  as  proposed  by  Collins  "Collins.  75] 
(or  Collins'  decomposition  in  short,  cf.  ]Cooke  and  Finney,  67]  for  a  basic 
description  of  cell  complexes)  relative  to  the  set  F  of  polynomials  appearing  in 
the  definition  of  FP  Roughly  speaking,  this  technique  partitions  A'i  +  1  into 
finitely  many  connected  cells,  such  that  on  each  of  these  cells  each  polynomial 
of  P  has  a  constant  sign  (zero,  positive,  or  negative)  Thus  FP  is  the  union  of 
a  subset  of  these  cells,  and  it  is  a  simple  matter  to  identify  those  cells  which  are 
contained  in  FP  (we  refer  to  such  cells  as  free  Collins  cells)  Moreover,  by 
using  the  modified  decomposition  technique  presented  in  ^Schwartz  and  Sharir, 
83b],  one  can  also  compute  the  adjacency  relationships  between  Collins  cells 
(i  e  .  find  pairs  [c  ,,c2]  of  Collins  cells  such  that  one  of  these  cells  is  contained  in 
the  boundary  of  the  other)  Thus  any  continuous  path  in  FP  can  be  mapped  to 
the  sequence  of  free  Collins  cells  through  which  it  passes,  and  conversely,  for 
any  such  sequence  of  free  adjacent  Collins  cells  we  can  construct  a  continuous 
path  in  FP  passing  through  these  cells  in  order  This  observation  has  been 
used  m  ^Schwartz  and  Sharir,  63b]  to  reduce  the  continuous  (static)  motion 
planning  problem  to  the  discrete  problem  of  searching  for  an  appropriate  path 
m  an  associated  connectivity  graph  whose  nodes  are  the  free  Collins  cells,  and 
whose  edges  connect  pairs  of  adjacent  such  cells. 

We  would  like  to  apply  the  same  ideas  to  the  dynamic  problem  that  we  wish 
to  solve,  but  we  face  here  the  additional  problem  that  we  are  allowed  to  consider 
only  t  -monotone  paths  in  FP.  To  overcome  this  difficulty,  we  note  that  the  Col¬ 
lins  decomposition  procedure  is  recursive,  proceeding  through  one  dimension  at 
a  time  When  it  cornes  to  decompose  the  subspace  £■)*',  it  has  already  decom¬ 
posed  Ex  into  "base"  cells,  and  the  decomposition  of  E ,M  will  be  such  that  for 
each  base  cell  b  of  E 1  there  will  be  constructed  several  "layered"  cells  of  £’l  +  I 
all  projecting  into  b  Hence  if  we  apply  the  Collins  decomposition  technique  in 
such  a  way  that  the  time  axis  t  is  decomposed  in  the  innermost  recursive  step, 
it  follows  that  each  final  cell  c  (in  Ed*1)  consists  of  points  X.t]  whose  t 
either  lies  between  two  boundary  times  t0{c)  <  f  j(c)  or  is  constant  Moreover, 
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;  ,  ,  a  Ccii:ns  ce  l  of  the  first  type,  then  it  is  easy  to  show,  using  induction  on 

the  dimension,  that  for  any  point  .'Afc.fovc)]  lym g  on  the  "lower"  boundary  of  c . 
and  for  any  point  ' Xx.t  ,(c)]  on  its  "upper”  boundary,  there  exists  a  continuous 
mcnotone  path  through  c  connecting  these  two  points.  In  fact,  the  preceding 
property  also  holds  if  one  or  both  of  these  points  are  interior  to  c 

These  observations  suggest  the  following  procedure. 

(;)  Apply  the  Collins  decomposition  technique  to  Ed*x  relative  to  the  set  of 
polynomials  defining  FP,  so  that  t  is  the  innermost  dimension  to  be  processed 
.Also  find  the  adjacency  relationship  between  the  Collins  cells,  using  the  tech¬ 
nique  described  in  'Schwartz  and  Shanr,  83b] 

(2)  Construct  a  connectivity  graph  CG,  which  is  a  directed  graph  defined  as 
follows:  The  nodes  of  CG  are  the  free  Collins  cells.  A  directed  edge  jc.c1]  con¬ 
nects  two  free  cells  c  and  c‘  provided  that  (a)  c  and  c'  are  adjacent;  (b) 
either  c  and  c'  both  project  onto  the  same  base  segment  on  the  t  axis,  or  c 
projects  onto  an  open  t  segment  (fc(c).f  i(c ))  and  c'  projects  onto  its  upper 
endpoint  fj(c),  or  C  projects  onto  an  open  t  segment  (f  c(c'),*  ,(c '))  and  c 
projects  onto  its  lower  endpoint  t0(ctag)  Intuitively,  each  edge  of  CG 
represents  a  crossing  between  two  adjacent  cells  which  is  either  stationary  in 
time  (crossing  in  a  direction  orthogonal  to  f),  of  else' progresses  forward  in 
time. 

(3)  Kmd  the  cells  cc.c,  containing  resppctively  the  initial  and  final 
configurations  [Af0,0],  'AY  7  ].  Then  search  for  a  directed  path  in  CG  from  cc  to 
c,.  If  there  exists  such  a  path  then  there  also  exists  a  motion  in  FP  between 
the  two  given  configurations  (ana  the  latter  motion  can  be  effectively  con¬ 
structed  from  the  pain  in  CG),  otherwise  no  such  mulion  exists. 

To  see  that  the  procedure  just  described  is  correct,  note  first  that  if  p  is  a 
continuous  motion  through  FP  between  the  initial  and  final  configurations 
(which  we  assume  to  cross  between  Collins  cells  only  finitely  many  times),  then 
it  is  easily  seen  that  the  sequence  of  free  cells  tlirough  which  p  passes  consti¬ 
tutes  a  directed  path  in  CG  Conversely,  if  p'  is  a  directed  path  in  CC 
between  cc  and  then  p '  can  be  transformed  into  a  continuous  (monotone) 
motion  through  FP  as  follows  First  choose  for  each  free  Collins  cell,  c  a 
representative  interior  point  \Xc,tQ},  such  that  the  representative  points  of  all 
the  cells  that  project  onto  the  same  base  segment  on  the  t  axis  have  the  same 
t  value  Then  transform  each  edge  "c.c'j  of  p'  into  a  monotone  path  in  FP  as 
follows  If  tc  =  tc  (i  e  ,  if  the  crossing  from  c  to  c'  is  orthogonal  lo  the  time 
axis),  then  connect  rAfc,fcl  to  [X,-  .  tc  ]  by  any  path  which  is  contained  in  the 
union  cue'  and  on  which  t  is  held  constant,  the  existence  of  such  a  path  is 
✓'-guaranteed  by  the  property  of  Collins  cells  noted  above  If  iQ  <  tc  then  con¬ 
nect  'A'c,fc]  to  _Xc.tc]  by  a  monotone  path  contained  in  c  uc.’,  again  the 
existence  of  such  a  path  is  guaranteed  by  the  structure  of  Collins  cells  The 
resulting  pafh  p  is  plainly  continuous,  is  contained  in  FP  and  is  weakly  mono¬ 
tone  in  t  (Note  that  the  crossings  of  the  first  type  in  which  t  remains  con¬ 
stant  represents  extreme  situations  where  the  velocity  of  B  is  infinite.  How¬ 
ever,  since  p  is  continuous  and  FP  is  open,  one  can  easily  modify  p  shghtly 
so  as  to  make  it  strictly  monotone  in  time.)  This  establishes  the  correctness  of 
our  procedure 

Since  the  Collins  decomposition  is  of  size  polynomial  in  the  number  of  given 
polynomials  and  in  their  maximal  degree  (albeit  doubly  exponential  in  the 
number  of  degrees  of  freedom  d),  and  can  be  computed  within  time  of  similar 
polynomial  complexity,  it  follows  that 
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THEOREM  4.2.  The  dynamic  hinres trie < ei  version  of  the  movers  problem  for  a 
fixed  moving  B  can  be  solved  in  the  general  ( space-time )  algebraic  case  in 
time  polynomial  in  the  number  of  obstacles ,  tne  number  of  parts  of  B,  and 
their  maximal  algebraic  degree 
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Snapshots  of  D0  UDj  at  angular  displacements  of 
0=0,  ir/2 ,  it,  3tt/4. 


